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Abstract — This  paper  considers  the  problem  of  automatically 
coordinating  multiple  platforms  to  explore  an  unknown  envi¬ 
ronment.  A  newly  developed  method  for  this  problem  consists  of 
deterministically  placing  locales  within  the  region  and  then  using 
the  Probabilistic  Multi-Hypothesis  Tracker  (PMHT)  to  associate 
these  locales  with  the  platforms  at  specific  times.  The  method 
uses  an  integer  number  of  locales  at  discrete  locations  to  guide 
the  platforms.  This  paper  extends  the  method  to  instead  guide  the 
platforms  using  a  continuous  valued  non-uniform  intensity  map 
over  a  continuous  spatial  domain.  The  existing  method  is  shown 
to  be  a  discretised  approximation  to  the  continuous  intensity  map. 

I.  Introduction 

Multiple  platform  path  planning  is  a  problem  that  arises  in 
many  applications  including  search  and  rescue,  coordinated 
surveillance,  multiple  platform  simultaneous  localisation  and 
mapping  (SLAM)  and  resource  dissemination  (the  travelling 
salesman).  Independent  of  the  application,  the  goal  is  to 
schedule  multiple  mobile  resources  with  dynamic  constraints 
to  cover  an  area  in  an  efficient  manner. 

There  are  many  strategies  to  coordinate  a  single  moving 
platform  to  intelligently  explore  an  environment.  Most  of  these 
strategies  take  different  factors  into  account  before  choosing  an 
action,  such  as  the  localisation  error  of  the  platform’s  sensors 
or  the  information  gain  potential  through  the  measurements 
that  these  sensors  may  collect.  Generally  these  approaches 
enumerate  a  collection  of  hypotheses  based  on  feasible  motion 
of  the  platform  and  use  a  cost  function  as  the  decision 
criterion.  For  example,  one  strategy  is  to  move  the  platform 
to  build  the  map  information  as  quickly  as  possible  with 
localisation  being  less  important,  such  as  [1].  In  contrast,  under 
Active  Localisation  [2],  the  platform  self  localisation  is  most 
important  and  the  platform’s  movement  is  chosen  based  on 
what  will  be  likely  to  reduce  the  localisation  uncertainty.  Other 
methods  seek  to  optimise  the  view  points  of  the  platform  to 
maximise  the  expected  information  gain  in  building  the  map 
and  to  minimise  the  uncertainty  of  the  platform  within  the  grid 
cells  of  the  map  [3].  These  strategies  may  be  greedy  one  step 
ahead  or  N  step  ahead  and  are  generally  for  single  platforms. 

It  has  been  widely  acknowledged  within  the  autonomous 
vehicle  research  community  that  the  use  of  multiple  coop¬ 
erating  vehicles  for  exploration  tasks  has  many  advantages 
over  a  single  vehicle  architecture.  Multiple  vehicles  have  the 


potential  to  explore  and  map  an  environment  more  quickly 
than  a  single  vehicle,  are  more  robust  to  failures,  and  provide 
a  broader  field  of  view  in  dynamic  environments.  To  achieve 
cooperative  exploration,  the  key  problem  is  to  choose  appro¬ 
priate  actions  for  the  platforms  so  that  they  simultaneously 
explore  different  regions  of  the  environment  optimally.  Similar 
to  the  single  platform  strategies,  there  are  extensions  to  the 
multiple  platform  case,  such  as  [4]  to  build  a  map  as  quickly 
as  possible  and  [5]  using  information  gain  to  coordinate  the 
multiple  platforms. 

A  new  approach  for  multiple  platform  path  planning  was 
introduced  in  [6].  This  method  used  the  Probabilistic  Multi- 
Hypothesis  Tracker  (PMHT)  to  design  trajectories  for  the 
platforms  based  on  known  initial  platform  conditions  (position, 
speed,  heading).  A  set  of  locales  was  created  to  assist  the  plan¬ 
ning,  which  were  discrete  locations  within  the  area  of  interest. 
The  assumption  was  that  the  original  planning  problem  could 
be  solved  by  constructing  platform  trajectories  such  that  all  of 
these  locales  were  visited  at  least  once. 

The  novelty  in  the  PMHT  path  planning  approach  is  to 
recognise  that  the  path  planning  problem  is  mathematically 
equivalent  to  a  tracking  problem  where  the  locales  are  anal¬ 
ogous  to  measurements  and  the  platforms  are  analogous  to 
targets.  This  means  that  the  problem  can  be  solved  using 
a  multi-target  tracking  algorithm,  where  the  data  association 
capability  of  the  tracker  is  used  to  decide  which  platform 
should  visit  each  landmark  and  at  which  time.  The  tracker 
ensures  that  each  of  the  locales  is  visited  by  at  least  one  of 
the  platforms,  while  constraining  the  motion  of  the  platforms 
to  a  realistic  dynamic  model.  The  difficulty  is  that  the  locales 
have  no  intrinsic  temporal  relationship.  Whereas  in  tracking 
the  usual  assumption  is  that  the  input  information  is  noisy 
position  estimates  collected  at  known  times,  here  there  are 
no  times  associated  with  each  locale;  there  is  not  even  a 
preferred  order  in  which  to  visit  them.  In  order  to  overcome 
this  problem,  hypothesised  time-stamps  are  treated  as  hidden 
variables  and  the  PMHT  is  used  to  associate  the  locales  to 
platforms  and  times  simultaneously. 

The  PMHT,  developed  by  Streit  and  Luginbuhl  [7],  is  a 
data  association  algorithm  derived  from  the  application  of 
the  Expectation  Maximisation  (EM)  algorithm  [8]  to  target 
tracking.  The  PMHT  uses  EM  to  model  the  assignment  of 
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measurements  to  targets  as  hidden  variables  and  estimates 
target  states  by  taking  the  expectation  over  the  assignments. 
The  advantage  of  the  PMHT  over  alternative  data  association 
techniques  is  that  it  has  linear  complexity  in  the  number 
of  targets,  the  number  of  measurements  per  frame,  and  in 
the  number  of  frames.  In  contrast,  other  data  association 
methods  incur  a  complexity  that  grows  with  the  number  of 
permutations  of  measurements  and  targets  within  a  frame  and 
then  exponentially  with  time. 

In  the  context  of  the  planning  problem,  PMHT  allows 
for  batch  data  association  over  hundreds  of  time  steps  with 
multiple  platforms  in  a  field  of  hundreds  of  locales.  It  is 
also  built  on  an  EM  framework  which  is  amenable  to  the 
incorporation  of  the  missing  temporal  information. 

The  initial  work  of  [6]  derived  the  PMHT  path  planning 
algorithm  using  the  above  notion  of  a  set  of  discrete  locales. 
Qualitative  examples  of  the  resulting  paths  were  presented 
in  [6]  and  the  method  was  quantitatively  compared  with  a 
genetic-algorithm  alternative  in  [9].  This  initial  work  generally 
used  a  uniform  placement  of  locales,  either  deterministically 
placed  in  a  grid,  or  randomly  placed  by  sampling  a  uniform 
spatial  distribution.  In  this  paper,  we  generalise  this  driving 
model  in  two  ways.  Firstly  we  demonstrate  how  to  incorporate 
a  non-homogeneous  (i.e.  spatially  non-uniform)  locale  set,  and 
secondly  this  non-homogeneous  discrete  set  of  points  is  gen¬ 
eralised  to  an  arbitrary  intensity  function  over  a  continuous¬ 
valued  spatial  area. 

The  resulting  improvement  to  the  PMHT  path  planner  no 
longer  uses  the  notion  of  artificially  generated  locales  to 
guide  the  platform  trajectories.  Instead  it  is  driven  by  an 
intensity  function,  which  (for  example)  could  be  a  probability- 
hypothesis-density  (PHD)  [10]  representation  of  the  number 
and  spatial  distribution  of  targets  within  a  surveillance  volume. 

The  remainder  of  this  paper  is  arranged  as  follows:  section 

II  reviews  the  existing  PMHT  method  for  path  planning  using 
a  uniformly  weighted  collection  of  artificial  locales.  Section 

III  extends  this  to  a  non-uniformly  weighted  set  of  discrete 
locales  by  introducing  the  concept  of  locale  priority.  Section 

IV  generalises  this  further  by  transforming  the  discrete  locale 
grid  into  a  continuous  density.  Section  V  provides  a  simulation 
example,  and  VI  provides  a  summary. 

II.  PMHT  for  Multiple  Path  Planning 

The  PMHT-pp  algorithm  is  an  extension  of  the  standard 
PMHT  to  address  the  problem  of  path  planning  for  multiple 
platforms  in  a  field  of  discrete  locales  [6].  The  PMHT-pp 
derivation  in  [6]  is  very  similar  to  that  of  the  standard  PMHT, 
presented  in  detail  in  [7]  and  [11].  The  development  of  PMHT- 
pp  is  sketched  here  with  more  detail  provided  in  areas  that 
become  important  for  the  following  sections.  For  a  complete 
derivation,  see  the  above  references. 

Let  there  be  N  locales,  z\...zn,  with  Z  =  {zn}^=1 
denoting  the  whole  locale  set.  Assume  that  there  are  M 
platforms  and  that  they  are  to  be  guided  amongst  these  locales 
over  a  time-horizon  of  T  uniformly  sampled  time  steps. 


Let  the  state  of  platform  m  at  time  t  be  denoted  x™,  the 
set  of  all  states  for  platform  m  be  denoted  Xm  = 
and  the  set  of  all  states  be  denoted  X  =  {Xm}^=1.  For  the 
purpose  of  this  paper,  the  state  consists  of  position,  velocity 
and  acceleration  in  the  plane. 

It  is  assumed  that  the  prior  distribution  of  the  state  of  each 
platform  is  known  and  is  given  by  ^(x™)  for  platform  m. 
The  platform  dynamics  are  also  assumed  to  be  known  and 
can  be  described  by  the  evolution  probability  density  function 

(pdf)  v-TOCI*™  A 

To  codify  the  decision  of  which  platform  should  visit  each 
locale  and  at  which  time  slot,  we  introduce  two  hidden 
assignment  variables.  Let  the  platform  assigned  to  locale  n 
be  kn  G  {1 . . .  M},  with  K  =  {kn}^=1  denote  the  set  of  all 
platform-to-locale  assignments.  Let  the  time  at  which  locale  n 
is  visited  by  a  platform  be  rn  G  {1 . . .  T}  and  r  =  {rn}n=i 
denote  the  set  of  all  time-to-locale  assignments.  Both  of  these 
are,  of  course,  unknown.  Treat  both  kn  and  rn  as  random 
variables  with  priors  7r^m  and  7r^t  respectively.  These  priors 
are  also  unknown,  and  nr  denote  the  collection  of  platform 
and  time  assignment  priors  respectively. 

The  path  planning  problem  is  solved  by  optimising  a  cost 
function  that  is  mathematically  equivalent  to  the  log-likelihood 
of  a  tracking  problem  where  the  locales  are  instead  random 
measurements  and  the  platforms  are  targets.  The  cost  of 
assigning  locale  n  to  platform  m  at  time  t  is  a  function  of 
the  positions  of  the  two  at  time  t  and  is  analogous  to  the 
measurement  pdf  in  the  tracking  problem.  Assume  a  linear 
Gaussian  measurement  pdf 

((zn\x?)~N(zn-,Hx™,R)  (1) 

where  m  =  kn,  t  =  rn,  H  is  the  measurement  function  and 
R  is  the  measurement  noise.  This  function  could  be  different 
for  each  locale  or  each  platform  but  is  assumed  the  same  here 
to  clarify  notation. 

The  aim  of  the  planning  problem  is  to  find  the  best  states, 
X.  To  do  this  it  would  appear  that  we  are  forced  to  also  jointly 
optimise  for  the  assignments,  K.  However,  PMHT  treats  these 
assignments  as  nuisance  parameters  (missing  data)  and  uses 
EM  to  iteratively  marginalise  them  out  of  the  problem. 

In  the  PMHT  context,  EM  consists  of  two  alternating  steps 
that  are  iteratively  repeated  until  convergence.  In  the  E-step, 
the  probability  of  each  possible  assignment  of  platform  and 
time  to  a  locale  is  determined  using  the  previous  platform 
state  estimate.  In  the  M-step,  an  auxiliary  function  is  optimised 
to  find  the  new  platform  states.  The  auxiliary  function  is  the 
expectation  of  the  joint  log-likelihood  over  the  missing  data, 
which  now  takes  the  form: 
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where  the  summation  is  over  all  permutations  of  the  assign¬ 
ment  variables  r  and  K ,  and  X(i)  denotes  the  estimated  state 
at  the  ith  EM  iteration. 

Due  to  the  independence  assumptions 


P(X,r,K,Z-,UT,Uk)  = 

P{X)P(t ;  I V)P(K;  Uk)P(Z\X,  r,  K),  (3) 


where 
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The  conditional  probability  of  the  missing  data, 
P(t,  K\X(i),  Z;flT(i),nk(i)),  is  represented  by  a  set 
of  weights,  which  are  given  by  [6]  as: 
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where  the  iteration  index  (i)  is  suppressed  for  clarity. 

Thus  the  conditional  probability  of  the  assignments  is  given 
by  the  product  of  individual  per  locale  weights.  Each  weight, 
^n,rn,kn ,  is  the  normalised  likelihood  of  the  nth  locale  from 
platform  kn  at  time  rn.  The  numerator  of  the  weight  is  the 
product  of  the  assignment  priors  and  the  positional  locale 
likelihood. 

Combining  the  two  equations  (3)  and  (8)  leads  to  the 
auxiliary  function  to  be  maximised: 


Q(X,U\Hk\X(i),UT(i),Uk(i)) 

=  log-P(X)+  ^2  wntm  log  <t+  E!  wntm  log  irkm 
n,t,m  n,t,m 

+  53  Wntm\og((zn\x,ln) 

n,t,m 

=  Qx  +  Qu  +  Qu  (9) 

The  term  Q ^  in  (9)  is  given  by 

Qu  =  ^2  wntrn  log<t, 

n,t,m 


and  is  similar  to  that  of  the  standard  multi-sensor  PMHT  [12]. 
It  is  maximised  subject  to  the  constraint  that  7r^t  =  1  using 
a  Lagrangian,  resulting  in  the  updated  prior  estimate 

M 

^ nt  (3  1)  =  ^  ^  wntrm  (10) 

m= 1 

i.e.  the  weights’  relative  frequency  for  time  t. 

Similarly,  the  term  results  in  a  relative  frequency 
estimate  for  the  platform  to  locale  assignment  prior 

T 

7rnm('i'  "b  1)  =  ^  ^  wntm •  (H) 

t=  1 

The  remaining  term,  Qx,  couples  the  platform  states  and 
the  locales  and  is  given  by 

Qx  =  log  P(X)  +  5^  Wntm  log  ((Zn\x™).  (12) 

n,t,m 

For  a  Gaussian  penalty  function,  ((zn  lx™),  it  can  be  shown 
that  this  function  is  equivalent  to  the  log  likelihood  of  a 
tracking  problem  with  known  data  association  [13], 

Qx  =  log  P(X)  +  5>g  C(Sr\xT),  (13) 

t,m 

where  the  synthetic  locale,  z™,  is  given  by 

1  N 

%t  =  ^  >  wntmzm  (14) 

X/n=  1  Wntm  n=i 

and  the  synthetic  locale  function,  £(•),  is  a  Gaussian  distributed 
random  variable  with  the  same  mean  as  the  true  locale  function 
and  a  variance  that  is  a  scaled  version  of  the  sensor  locale 
variance,  R , 

K  =  - R-  (i5) 

/  jU—\  Wntm 

The  path  for  platform  m  is  now  refined  by  smoothing 
the  synthetic  locales  and  covariances.  The  planning  algorithm 
consists  of  iteratively  calculating  assignment  weights,  wntrn, 
and  estimating  the  platform  paths  and  assignment  priors  until 
convergence. 

III.  Non-Homogeneous  Locales 

The  previous  section  described  the  path  planning  algorithm 
with  a  set  of  locales  that  were  all  equally  important.  In  the 
examples  provided  in  [6],  [9]  these  locales  were  generally 
placed  as  a  uniform  grid.  However,  there  are  many  applications 
where  not  all  locations  in  the  search  space  will  be  equally 
important.  We  now  demonstrate  a  non-homogeneous  locale 
map  based  on  a  model  of  locale  priority. 

Suppose  a  particular  locale,  s  was  more  important  than  the 
others.  This  means  that  we  would  like  the  output  of  the  path 
planning  algorithm  to  place  higher  emphasis  on  passing  close 
to  the  location  s  than  other  locations  in  the  search  space.  There 
are  two  obvious  ways  in  which  the  path  planner  could  be 
influenced  to  achieve  this.  The  first  is  to  place  duplicate  locales 
at  s.  If  there  is  more  than  one  locale  then  this  will  have  the 
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same  effect  as  collecting  two  sensor  observations  at  a  certain 
location:  the  resulting  state  estimate  will  be  closer  to  5  than 
if  there  was  only  one.  Alternatively,  the  fitting  covariance  R 
could  be  scaled  for  locale  s,  analogous  to  the  assertion  that 
this  locale  is  more  accurate  than  the  others.  We  will  follow 
the  first  method. 

Suppose  that  a  certain  locale  s  is  duplicated,  so  that  there 
are  now  TV  +  1  locales,  [1 . . .  TV]  U  s.  This  does  not  change 
the  association  weights,  since  they  are  independent  for  each 
locale.  What  changes  is  the  range  of  the  summand  in  the  locale 
contribution  to  Qx  in  (12).  The  effect  of  this  is  to  duplicate 
the  term  due  to  locale  8  in  the  synthetic  locale  and  covariance, 
namely  (14)  becomes 


iV+1 
/  jn—l  ^ntm^n 
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Similarly  for  the  synthetic  covariance  in  (15)  becomes 


iff 


1 


Wntm 
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- R. 

+  wstrn 


The  state  estimation  proceeds  as  previously  and  the  resulting 
path  will  be  influenced  to  pass  closer  to  z3. 

The  intuitive  extension  of  this  is  now  to  place  an  integer 
number  of  copies  of  each  locale,  7?n,  with  a  higher  value  of 
r\n  where  the  locales  have  higher  priority.  As  before,  each  of 
these  duplicates  has  the  same  weight  as  zn,  so  the  synthetic 
locale  (14)  and  covariance  (15)  become 
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(16) 

(17) 


Note  that  by  introducing  the  priority  r\n  the  effect  is  to 
reduce  the  synthetic  covariance  R ™  since  Yln= 1  wntmVn  > 
J2n= 1  wntm  this  can  be  compensated  for  by  using  a  larger 
initial  value  of  R,  although  this  will  influence  the  weights. 


IV.  PMHT-pp  with  Priority  as  a  Continuous 
Density 

Although  the  variable  r]n  represents  a  count  of  the  number  of 
duplicates  of  zn  the  resulting  synthetic  locale  and  covariance 
in  (16)  and  (17)  could  be  evaluated  for  non-integer  values  of 
r]n.  Accordingly,  we  will  now  refer  to  r]n  as  the  priority  of 
locale  n  and  allow  it  to  take  on  a  positive  semi-definite  con¬ 
tinuous  value.  This  could  be  achieved  rigorously  by  defining 
fjn  =  \j]n/Ti2\  and  taking  the  limit  as  ft2  -A  0  in  the  same 
manner  as  the  derivation  of  Histogram-PMHT  [14].  However, 
this  proof  is  omitted  due  to  space  limitations. 

Suppose  now  that  the  exploration  area,  A,  is  a  region  in 
the  plane  and  there  is  a  known  continuous  priority  intensity, 
p(z)  >  0 Mz  e  A  C  5ft2. 


Define  a  uniform  grid  of  TV  pixels  in  the  exploration  area 
with  pixel  size  A2.  Let  the  center  of  pixel  n  be  zn  and  the 
priority  of  pixel  n  be  r]n  =  A 2  p(zn).  Clearly  r]n  is  a  piecewise 
constant  approximation  to  p(z).  If  p(zn)  is  the  intensity  of 
a  Poisson  point  process,  then  r\n  is  the  expected  number  of 
locales  in  the  area  of  pixel  zn.  Further  we  could  interpret 
{Vn,zn}  as  a  sample  approximation  of  the  intensity 

N 

*(*-*»)*„  (is) 

n—  1 


where  S(z)  is  the  Dirac  delta  function. 

Redefine  the  weight  notation  from  wntm  to  wtm(zn),  which 
gives  us  the  ability  to  represent  weights  for  any  z  e  A,  i.e. 


Wtrn  (^) 
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(19) 


The  advantage  in  using  this  continuous  valued  ijn  is  that 
priorities  can  be  balanced  between  locales  without  leading  to 
a  deflation  of  R 

Consider  now  the  state  dependent  term  from  the  auxiliary 
function,  i.e.  Qx  given  by  the  modification  of  (12)  to  include 
the  priority 


NTM 

Qx  =  log  P(X)  +  EEE  VnWtm  0„  )  log  COn  OD » 

n= 1  t=  1  m=l 
T  M 

=  log  P(X)  +  ^^gtm.  (20) 

t=  1  m= 1 


where  qtm  represents  the  locale  contribution  to  the  auxiliary 
function  for  platform  m  at  time  t.  Recalling  that  (  is  a  multi¬ 
variate  Gaussian  with  mean  Hx™  and  covariance  R,  so 


logCOnOn  =  const  -  \(z n  -  Hx™)1  R  -  Hx™), 

(21) 

where  the  constant  term  is  due  to  the  normalising  term  in  the 
Gaussian  pdf  and  is  common  for  all  locales  and  platforms. 

We  now  substitute  (21)  into  (20)  and  take  the  limit  of  the 
auxiliary  function  as  A2  — >  0.  It  suffices  to  consider  each  qtm 
individually  as  shown  in  equations  (22)  through  (25)  below. 
The  constant  term  in  these  equations  changes  from  one  step  to 
the  next  but  contains  only  irrelevant  terms  that  are  independent 
from  the  target  state. 

The  progression  from  summation  to  integral  in  (23)  follows 
the  Riemann  notion  of  integration,  which  is  sufficient  for  the 
types  of  functions  we  expect  for  p(z)  and  wtm(z).  The  new 
synthetic  locale  and  covariance  implicitly  defined  by  (24)  and 
(25)  are  given  by 
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i?r  =  - - - - R.  (27) 

/  Wtm(^)  /»(*)  dz 

Although  we  have  arrived  at  this  point  through  the  limit  of 
a  uniform  grid  of  locales,  the  same  result  could  be  obtained 
for  a  less  regular  configuration  in  the  same  way  that  Riemann 
integration  need  not  be  derived  from  a  set  of  intervals  with 
equal  support.  Using  something  other  than  the  uniform  grid 
would  result  in  a  locale-dependent  A2 ,  but  the  limit  as  all  of 
these  approach  zero  would  be  the  same. 

The  resulting  algorithm  no  longer  relies  on  a  set  of  artificial 
points  in  the  exploration  region  to  guide  the  trajectories. 
Moreover  it  even  provides  a  satisfying  interpretation  of  the 
original  method:  the  discrete  grid  of  locales  used  to  define 
the  exploration  region  in  [6]  can  be  seen  to  be  a  numerical 
approximation  to  the  path  planning  solution  for  a  uniform 
priority  intensity  map.  We  note  that  the  integrals  in  (26)  and 
(27)  do  not  appear  to  be  tractable  since  wtm(z)  is  the  ratio 
of  a  Gaussian  to  a  sum  of  Gaussians.  So  it  is  likely  that 
a  numerical  integral  approximation  would  need  to  be  used 
resulting  in  essentially  the  algorithm  in  section  III. 

The  result  described  above  assumes  a  constant  priority 
intensity  function,  p(z).  An  important  extension  would  be  to 
make  p(z)  time-varying  and  dependent  on  the  target  state.  This 
then  would  allow  the  intensity  function  to  actually  represent 
the  expected  number  of  targets  in  a  region,  conditioned  on 
the  sensor  data,  i.e.  the  PHD.  In  this  case,  the  path  planning 
solution  could  solve  a  much  more  general  sensor  resource 
scheduling  problem. 

V.  Simulation  Example 

The  difference  between  the  existing  PMHT-pp  method  pre¬ 
sented  in  [6]  and  the  new  method  derived  in  this  paper  is  now 
illustrated  through  a  simple  simulation.  We  refer  to  the  new 
method  as  non-homogeneous  PMHT-pp. 

Assume  that  the  exploration  area  A  is  a  10  unit  square 
box.  The  PMHT-pp  method  guides  a  single  platform  through 
the  area  by  constructing  a  10  x  10  uniform  grid  of  discrete 
locales.  Whereas  the  non-homogeneous  PMHT-pp  is  guided  by 


an  intensity  function  that  is  a  sum  of  two  Gaussian  components 
on  a  uniform  pedestal, 

2  1 

/'(-) = o.oi + yNxp  { -  -jiz  -  /'.Tu  \z  -  /'./)}•  (2§) 

3  =  1 

with  W  =  [8, 3]T,  Ei  =  0.251,  p2  =  [4, 8]T  and  E2  = 
diag(16,0.8).  The  priority  intensity  contains  an  isolated  point 
of  high  priority  represented  by  the  first  component  and  a 
narrow  ridge  of  high  priority  represented  by  the  second. 

The  platform  state  was  assumed  to  follow  a  constant  ac¬ 
celeration  model  independently  in  X  and  Y.  Thus  the  state 
evolution  process  is  defined  by 

ip(xt\xt-i)=Af(xt;Fxt,Q),  (29) 

where  A f(t\  p,  X)  is  a  multivariate  Gaussian, 
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and  Q  =  10  8/.  The  fitting  penalty  (analogous  measurement 
probability  density)  function  was  linear  and  Gaussian, 


c{zn\xt)  =  M (zn;Hxt,R) ,  (30) 


with  H  = 


1  0  0  0  0 
0  0  0  1  0 


0 

0 


and  R  =  10  2/. 


T  =  500  time  points  were  used.  The  platform  was  initialised 
at  position  [0,  0]  with  zero  speed  and  zero  acceleration. 

Figure  1  shows  the  output  of  the  discrete-locale  PMHT-pp 
over  the  uniform  grid.  A  trajectory  is  created  that  spans 
the  grid  of  locales.  Since  the  algorithm  is  not  aware  of  the 
higher  priority  regions,  the  path  pays  no  particular  attention 
to  them.  In  particular,  the  platform  does  not  closely  visit  the 
area  around  [8,3].  Figure  2  shows  the  output  of  the  non- 
homogeneous  PMHT-pp  overlaid  on  the  priority  intensity  map, 
as  represented  by  (28).  Clearly  the  paths  in  figures  1  and  2 
are  very  different.  The  non-homogeneous  PMHT-pp  focuses 
on  the  locations  of  high  priority  and  quickly  skirts  over  the 
remaining  area.  Because  the  variance  of  the  first  intensity 
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Fig.  1.  Discrete-locale  PMHT-pp  trajectory 


component  is  so  small,  the  platform  trajectory  passes  directly 
through  its  centre.  The  path  then  makes  several  passes  over 
the  extended  component. 

VI.  Conclusion 

Previous  work  extended  the  PMHT  data  association  method 
to  handle  the  case  where  measurement  time-stamps  were 
unreliable  or  even  completely  unknown.  This  was  then  applied 
to  the  problem  of  coordinating  multiple  platforms  through  an 
exploration  area  in  an  algorithm  referred  to  as  PMHT-pp.  This 
method  relied  on  the  introduction  of  discrete  locales  which 
were  then  associated  with  the  platforms  at  specific  times. 
PMHT-pp  treats  each  of  these  discrete  locales  as  equally  im¬ 
portant.  In  existing  examples  they  have  been  either  randomly 
placed  with  a  uniform  density,  or  distributed  over  a  grid. 

This  paper  has  extended  the  PMHT-pp  method  to  instead 
guide  the  platforms  using  a  non-homogeneous  intensity  map. 
This  allows  for  areas  of  higher  importance  and  removes 
subjective  parameters,  such  as  the  spacing  of  a  discrete  locale 
grid.  In  addition,  the  intensity  guided  PMHT-pp  produces  an 
intuitive  result  that  the  discrete-locale  method  is  simply  a 
numerical  approximation  to  the  intensity  PMHT-pp. 

Interestingly,  the  PMHT  was  developed  for  data  association 
in  target  tracking,  which  can  be  considered  to  be  a  point-to- 
point  assignment  problem.  In  contrast,  by  removing  the  timing 
information  and  taking  the  limiting  case  of  a  point-process 
measurement  model,  the  path  planning  problem  considered  in 
this  paper  effectively  uses  PMHT  to  assign  a  curve  to  a  surface. 

Although  the  algorithm  was  demonstrated  in  a  path  planning 
context,  it  is  intuitive  to  see  that  the  method  has  application  in 
a  wide  range  of  problems,  Fundamentally,  the  PMHT-pp  algo¬ 
rithm  efficiently  associates  a  finite  resource  between  multiple 
consumers  over  a  long  time  horizon  with  dynamic  constraints. 
It  could  be  applied  to  many  resource  management  problems. 
The  time  evolving  intensity  map  could  be  used  as  a  means  to 
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Fig.  2.  Non-Homogeneous  PMHT-pp  trajectory  with  priority  intensity  map 

provide  a  sensor  scheduling  algorithm  by  using  a  Probability 
Hypothesis  Density  map  of  probable  target  locations. 
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